geometry_msgs/Point position
geometry_msgs/Vector3 velocity

float64 yaw
float64 yaw_dot